/*==============================================================================
Description:
==============================================================================*/

#ifndef __INTERPOLATE_C__
#define __INTERPOLATE_C__

#include "interpolate.h"

/**********************************************************************

**********************************************************************/

void Interpolate_Calc(INTERPOLATE *p)
{
	  if (p->Input_X < p->X[0])
	  {
		  p->Output_Y = 0;
	  }
	  else if (p->Input_X < p->X[1])
	  {
		  p->Output_Y = ((p->Input_X-p->X[0])*(p->Y[1]-p->Y[0]))/(p->X[1]-p->X[0]) + p->Y[0];
	  }
	  else if (p->Input_X < p->X[2])
	  {
		  p->Output_Y = ((p->Input_X-p->X[1])*(p->Y[2]-p->Y[1]))/(p->X[2]-p->X[1]) + p->Y[1];
	  }
	  else if (p->Input_X < p->X[3])
	  {
		  p->Output_Y = ((p->Input_X-p->X[2])*(p->Y[3]-p->Y[2]))/(p->X[3]-p->X[2]) + p->Y[2];
	  }
	  else
	  {
		  p->Output_Y = p->Y[3];
	  }
}

/**********************************************************************

**********************************************************************/


#endif
//--- end of file ----------------------------------------------------
